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ABSTRACT 

A novel approach to the bilateral motion is realized in the master-slave robot hand 
system In the approach. there are neither force sensors nor tactile sensors in the slave 
hand The contact force of the slave hand is estimated by the disturbance observer in the 
microprocessor-based controller. The estimated force is calculated fro. the velocity and 
the current of the slave hand for the feedback to the master hand in order that the 
operator feels the touch quality of the object grasped by the slave hand to some extent. 
The position reference of the slave hand is given through the master position. These two 
cross feedback loops are implemented in one microprocessor, 
in two similar robot hands. The obtained results show the 
bilateral mo t i on. 



The above algorithm is tested 
sufficient performance of the 



1. INTRODUCTION 



for the manipulations 
Fo r the fine control 
often attached on the 



A bilateral robot hand is suitable 
the dangerous or the poor environment, 
force sensor or the tactile sensor are 

However not only these sensors are precious but also they often require 
p rocess ing. 3 Moreover, they are sometimes quite sensitive to the environmental 



of the object particularly in 
and the smooth operation, the 
surface of the slave hand. 1 ? 

much signal 
change . 



This paper proposes a novel approach to the control of the bilateral master-slave robot 
hand, where such a touch sensor is omitted in the slave hand. Instead of the touch sensors, 
the reactive force is estimated by the disturbance observer. As the necessary informations 
of the disturbance observer are only the armature current and the velocity of the slave 
' i H which are easily measured without any special sensors but ordinal servo sensors, the 
,sed method is robust against the inferior environments. In addition to this 
robustness, the proposed method requires less computational effort to estimate the reactive 
force. 



There are several ways to realize the bilateral servo systems.* The proposed strategy is 
basically applicable to any types of the master-slave systems, however, in the paper the 
above system is realized in the pair of similar one-degree-o f-f reedom robot hands and is 
tested. For the mu 1 t i -de grees-o f-f reedom manipulator systems. although a ljtU ® 
modification is necessary, the basic strategy is common. The operator feels well the touch 
quality according to the slave motion and consequently controls it successfully. To improve 
this touch quality, the frictions of the master side should be compensated in the 
controller. If the master hand is not same as the slave hand, this compensation is 
sometimes unnecessary. For example this case is realized when the master is a joy stick. 
Some experimental results when the proposed system is applied to the symmetrical bilateral 
robot hands are shown in this paper. However the disturbance observer is also applicable in 
an asymmetrical case. 



2. STATE OBSERVER TO ESTIMATE DISTURBANCE 



The disturbance observer estimates the total sum of the disturbance torque. As it 
depends on the structure of the. motor. the model of the actuator should be considered. The 
servo motor as an actuator is represented in the block diagram as shown in Fig. 1. The 
armature current is directly controlled by the current minor feedback loop. This results 
the simplified motor model as shown in Fig. 2. 
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Figure Block diagram of a dc servo motor 



Figure 2. Simplified block diagram of 
a controlled dc servo motor 
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Here : 



Vt 
la 
L 
R 

Kt 
Ke 

Tgen 

Text 

J 

D 

F 

the 
By 



term ina 1 
a rma tu r e 
armature 
a rma tu r e 



vo 1 tage 
current 
indue tanc e 
res j s tanc e 



torque constant 
counter e.m. f. constant 
generated motor torque 
reactive force and external force 
= inertia 

= damping coefficient 
= cou lomb friction 
= rotor speed 

upper suffix ref denotes reference value and the lower suffix n denotes nominal 
measuring the current and the velocity, the simple calculation represented in the 



and 
value 

hatched block diagram of Fig. 3 brings the following result. 



Tdis 



Text + (J -Jn) S w + (D-Dn) u + F 



(1) 



The first term is the external torque. The second is the varied self-inertia 
third is the varied viscosity and the forth is the coulomb friction. When Fig 
slave hand, the force for the feedback to the master controller is 
the second, the third and the forth terms. This is explained closely 
It is difficult to realize Fig. 3 due to the pure differentiation of 
The disturbance observer is constructed so as to suppress 
area where the noise is the main component. The obtained 



to the 
r emov ing 
chap ters. 
s i gna 1 . 
f requency 



torque. The 
3 i s app lied 
ob ta ined by 
in the later 
the velocity 
the unnecessary high 
observer is shown in 



Fig. 4, where g is the cut-off angular frequency to inhibit the pass of the high frequency. 



Jex\ 



le 



Figure 3. Calculation of 
the disturbance torque 

The obtained output Te, is represented as follows, 



Te 



Figure 4. Block diagram of 
the disturbance observer 



Te 



1 +— S 



Tdis. 



Eq. (2) shows that the 
t o rque , if g is chosen 
chosen more than from 
estimated torque as the 



(2) 



estimated disturbance torque is almost the same as the disturbance 
as large as possible. According to the former researches/* g is 
500(rad/sec) to 5000 Cr ad/s e c) , that is large enough to regard the 
disturbance torque. 
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3. B I LATERAL ROBOT HAND SYSTEM 



The re 
force fee 
the p os i 
b e twe en 
hand so a 
friction 
of the s 
that the 
and the v 
As they 
e s t i ma t e s 
resu) ted 
external 



are sever 
dback s ys t 
t i on of th 
the po s i t i 
s to decre 

is e s t i ma 
lave moior 
operator f 
i s c os i t y o 

are cons 
only th 

from eq. 
force is 



al methods to r 
em shown in Fig 
e mas te r hand g 
on of the maste 
ase this error, 
ted by the obse 

are used, 
eels the touch 
f the slave doe 
t an t and are ab 
e sum of the 
(1) and (2) by 

ob ta ined by 



ealize the bilateral servo system 
.5 is applied to the master-slave ro 
jves the position reference of the s 
r hand and the slave hand drives the 

The reaction torque except the 
rver where only the armature current 
The estimated reaction torque drives 
quality. In this bilateral hand 

s not change according to its po 
le to be treated as fixed nominal v 
external force and the coulomb 
substituting Jn and Dn into J and 
subtracting the coulomb friction 



In the paper, the 
bot hands. Here 
lave hand. The error 
motor of the slave 
effect of the cou 1 omb 
and the rotor speed 
the mo tor in order 
system, the inertia 
s i t ion and a 1 1 i tude. 
alues, the observer 
friction. This is 

D ■ espec t ive 1 y. The 
F from the estimated 
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disturbance According to the measured results of the coulomb friction, F is represented as 
Ihe sum of constant part and the proportional part depending on the normal force. Therefore 
estimated reaction torque of the slave hand is given as, 



Text = n-n> CTe-Fo) 



(3) 



where n 
c o u 1 o mb 



is the 



proportional constant between 0 and 1 and Fo is the constant part of the 
friction and its sign depends on the moving direction. This final result 

drives the master motor to generate the reaction force of the slave hand in the master 
aI ll obtain high sensitivity of the touch quality in the master side. it is necessary 
to ^omplslle^hJ Miction of the master hand. For that purpose. the master motor should 
generate the following torques, 



1 banc 



d t" 



♦ [hum + Fx. 



<4> 



Here Thand is the operator's force and lower suffix m represents the master side. If the 
generated torque of the master motor is equal to sum of the estimated reactive 
the slave hand and the friction of the master hand, then the operator fee s 
reaction torque of the slave hand. Consequently the master motor should support, 



torque 
we 1 1 



of 
the 



Here 
sens 



= A. 1 5X'. 

A is 
t i v i t y 



(5) 



the adjustment factor of the feeling and is determined according to 
of the touch quality. The voltage command of the master motor is 



the 



(6) 

In case the current source is adopted, the current command of the master motor is 



\ IT 



♦ Cm u> * + F 5 



<7; 



of 



The compensation of the frictions of the master hand makes the sensitivity 
-nqljty higher. In the later experiment the master hand and the slave hand is 
adjustment factor is chosen as 1.0. 



the touch 
similar and 



Master S: Ot 



i State Oboerv or 
to Esc; ma to 
£ x temai Force 



Figure 5. Master slave bilateral servo system based on the estimated force feedback 

4. EXPERIMENTAL SYSTEM 

The experimental system is set up to verify the proposed system. The schematic diagram 
of the experimental robot hand is shown in Fig. 6. As shown in Fig. 6. the calculation 
process of the disturbance observer, and the compensation of the friction effects in the 
both hands are carried out in one microprocessor. Also the position control of the slave 
hand is executed in the same processor. The proposed system is applied to the similar twin 
robot hand which has one-de gree-o f-f re edom. Fig. 7 shows one robot hand to be controlled. 
The approach motion of the gripper is driven by the dc servo motor through the ball screw 
which is symmetrical at the middle point. Therefore. the two nuts move oppositely each 
other and that enables to open and close the robot hands. And the gravity force does not 
influence the estimated torque because of this mechanical structure. The lead of the ball 
-crew is 4mm/:. The dc servo motor, the tachogene r a to r and the optical encoder are directly 

nected to the ball screw. The measured and calculated parameters are shown in Table. 1. 
the contrcj steps are carried out in one 16 bit microprocessor, 
:.54 msec. Th? digital pole of the disturbance observer is determined as 0.5. 



whose sampling rate is 
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Figure 6. Experimental bilateral servo system 
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Figure 7. Bilateral robot hand 



Tab le 



! rated ou tpu t 


22 


W 




! rated speed 


2000 


r. p. m. 




j rated current 


0. 97 


A 






8 


mH 




! » 


20 


U 




! Kt 


1. 36 


Kg-cm/A 




Ke 


13. 9 


V/K. r. p. 


m. 


■ Jn 


0. 1043 


Kg-cm J 




Dn (mas t e r ) 


9. 29X1 0" 


Kg-cm/r . 


p. s. 


(slave) 


11. 32X10° 


Kg-cm/r. 


p. s. 


| F (master) 


0. 350 


Kg-cm 




1 (slave) 


0. 231 


Kg-cm 
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5. EXPERIMENTAL RESULTS 
5.1. Position control of slave hand 

At first the position servo characteristics are tested in the master-slave bilateral 
system Fig. 8 shows the time response of the slave hand which is controlled to track the 
master hand movement. 



Dcm/DIV i 




- - - 200ms/DIV 

Fjgure 8. Time response of ihe slave hand by the movement of the master hand 
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5.2. Output of the state observer 



the load-cell. 



he output of the observer is shown in Fig. 9 when the slave hand grasps 
norizontal axis shows the measured pressure P and the vertical axis shows the output of 
of the observer. The upper line is measured when the pressure is increasing and the lower 
is measured when the pressure is decreasing. This relation is linearized when the frjction 
slave is compensated. The compensated result is shown in Fig. 10. 



force of the 
4 7N/DIV 
Te 




47N/DIV 



Text 



35N/DIV 

Figure 9. Relation between the pressure 
of the hand and the estimated torque 




I 35N/DIV 
Figure 10. Relation between the pressure 
of the hand and the estimated torque 
after the removal of coulomb friction 

This compensation seems effective except the speed of the rotor is zero, because the moving 
direction o v f the slave hand is not determined at that point. The right side line in Fig. 10 
shows this undetermined point. This is compensated by inserting the weighting factor which 
depends on the rotor speed in the friction compensation process. Fig. 11 shows the time 
response example of the observer output 
coincides with the measured imposed force 



Text 70N 



after above compensation. The estimated torque well 



P ssrr 




] 500ms/DIV 



Figure 11. Time response of the measured force and the calculated torque 

5.3. Friction and damping compensation of the master hand 

For the reduction of the operator's physical 
friction of the master hand. This compensation 
to move the master hand are shown in Fig. 12. 



e f fort, 
is based 



it is effective to compensate the 
on eq. (5). The experimental results 
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(a) without compensation (b) with compensation of friction and damping force 

Figure 12. Operator's force to move master hand 

Fig. 12 (a), as any compensations of master hand are not carried out, the required torque 
move the mater hand is very large. The compensation based on eq.(5) makes the master 
ha. .j to move smoothly. Fig. 12 (b) shows the compensated effect. The required torque to move 
the master har=d is reduced and the smooth operation is required. 
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5.4. Gripping the object 



The proposed algorithm is implemented in the experimental robot hand and is tested 
13 (a) shows the result when the slave hand grips the soft object. Fig. 13 <b) shows 
the slave hand grasps the hard object. In both cases. after grasping the object 
operator imposes his force four times. 



Fig. 
tha t 
the 
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(a) when the object is soft (b) when the object is hard 

Figure 33. Time response of the estimated torque when the slave hand grasps an object 

The operator feels well the touch quality in both cases. The proposed bilateral master- 
siave system works well in the experimental system. 



6. CONCLUSIONS 



Through a set of experiments, it is confirmed that the state observer is 
effective to detect the external force. A bilateral servo system based on the estimated 
force feedback is able to be implemented without the pressure sensor and is successfully 
applied to the master-slave robot hand. This proposed method is also expected to be 
expanded to more advanced robotic system. 
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